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Abstract. The paper presents an advanced method for solving contradictory problems of hybrid 
position-force control of the movement of walking robots by applying a 2D Extension Set. Using 
the linear and non-linear attraction point principle and the network of attraction curves, there is 
determined the 2D space Dependent Function generated by position and force in order to solve the 
robot real time control. The generalization of the extension distance and dependent function uses 
Extenics in Higher Dimensions theory eliminates the crisp logic matrix of Cantor logic which 
describes the position-force sequences. Thus was developed an optimization method for hybrid 
position-force control which ensures positioning precision and robot movement stability on rough 
terrain. The final conclusions lead to development of a methodology that allows obtaining high 
level results for hybrid position-force control using extended transformations onto the real numbers 
set and an optimization function generated by the extended dependence function in 2 D space. 


Introduction 


A safe and robust behaviour of robots and mechatronic systems in contact with objects in their 
environment is the basic requirement for accomplishing tasks according to the given application. 
Stable control of the object — robot interaction implies a difficult technical problem. Thus, for 
contact control a simple method called ,,position adaptation” is proposed by Whitney (1977) in 
which the contact force is used to modify the trajectory of the reference position of the robot’s end- 
effector. Control of the arching movement, which in essence is force control implicitly based on 
position, was suggested by Lawrence and Stoughton (1987) and Kazerooni, Waibel and Kim 
(1990). Salisbury (1980) presented an active control method of apparent rigidity of the robot end- 
effector in Cartesian space. In this method the reference position used as input to control the contact 
force and no reference point for force are used. Raibert, Craig (1981) and Manson (1980) ensure 
force and position control when the robot interacts with the environment by decomposing it into 
„position sub-space” and „force sub-space”. These two sub-spaces correspond to the robot’s 
movement directions, respectively free movement or constrained environment. 

There is a growing interest to this problem, based on the research done by Pelletier and 
Daneshmend (1990), Lacky and Hsia (1991) and Chan (1991). Pelletier and Daneshmend present a 
blueprint for the adaptive control device which would be used to compensate for the variations of 
the environment rigidity during movement. However, they then discovered this is subject to 
instabilities. Lasky and Hsia describe a control device system consisting of a conventional 
impedance control device in the inner loop and a trajectory alteration control device in the outer 
loop for tracking the force, but their proposal is based on the science and calculation of the 
manipulative dynamic model. Chan develops a control device with variable structure for impedance 
control under parameter uncertainty and outside distrubance, but this strategy requires exact 
knowledge of the location and rigidity of the environment in order to obtain good force control. 
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Extenics was developed by Cai Wen in 1983 and developed succesively, with a major 
impact in the scientific world of the last few years through results in e-learnig, data mining, image 
recognition, robotics, statistics and management research, among others [1, 2, 7, 10]. Extension set 
theory is a mathematical form for representing uncertainty which is an extension of classic set 
theory, with applications in many research fields [12-14]. Extenics is a field of study which aims to 
solve contradictory problems, as is the case of position — force control in the field of robotics, 
mechatronics and real time control. 


Architecure of the Explicit Position-Force Control System. 



























































































































































Xe=A,AA, Opi incremental transducer A hybrid position-force control system normally 
(4x4) achieves simultaneous control of position and 
force. In order to determine the control relations in 
this situation, one divides the AXp deviation 
1A ELN measured by the command system into Cartesian 
coordinates into two sets: AX" - corresponding to 
’ the force controlled component and AX? - 
TRIANGULAR corresponding to position control with actuation on 
AXp the axis, in accordance with the selection matrixes 
ze AXp 3 Sr and S, [5, 6]. Through this approach certain 
X, . y ; Sx BACK Cartesian coordinates of the robot end-effector are 
eI controlled in position while others are controlled 

A@p explicitly in force. 
The separate processing using separate laws 
n for position and force control requires significant 
— 4)" H ruson > rosor | preparation of the treatment of tasks and changes in 
> the implementation of the control loops; 
| AOf additionaly, this method may generate instability 
AXn AXt problems, especially during the transition of free 
kw! X ; Sf E and constrained movement [8, 9]. l 
4 4 There results the motion variation on the robot axis 
in relation to the end-effector motion variation 
roi from the relation: Aq= J! (q) AXr + J1(q) 
4 AXp, where AXp can be calculated from the 
++ coma relation: AX;=Kr (AX* - AXp), and Kp is the 
dimensional relation of the stiffness matrix. Noting 
APA Fp as the desired residual force and Kw the 
te physical stiffness the following relation is 





‘ s = -l x 
Fig.1. Architecure of the Position-Force obiane Xp Key “ED: 


Control System. 


The architecture of the hybrid position — force control system of robots with six degrees of freedom 
based on the Denevit — Hartenberg transformations is presented in Figure 1. The device sensors are 
used in two ways. In position control, the information obtained from the sensors is used to 
compensate the deviation of the robots’ joints, due to the load created by external forces, so that the 
apparent stiffness of the robot’s joint system is emphasised [11]. In force control, the joint is used as 
a force sensor, so that the manipulator is led in the same direction as the force received from the 
sensors, allowing the desired contact force to be maintained. 


Extension Hybrid Force-Position Robot Control 

Extenics is the science that deals with solving contradictory problems. In this paper the aim is to 
solve the contradictory problem of hybrid position — force control of the movement of robotic and 
mechatronics systems by replacing the logic 0 and 1 values in the selection matrices Sx and Sf, 
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pertaining to force — position sequences using Cantor logic, with values of the dependent function 
using extended distance. Moreover, through a domain extension transformation for position Sxx, 
respectively a domain extension transformation for force Sx, a new selection matrix with 
correlation coefficients for position, respectively one force force, are obtained, which allows for the 
determination of the position error signals €x, and force error signals €x¢ with the aim of closing the 
control system loops in position and force. 





Fig. 2. Subdomains of the universe of discourse in reference to the position and force errors 


In a first stage that is offline, the universe of discourse U is defined for the position and 
force errors presented in Figure 2. Thus, the standard positive domain DSP is defined as the 
projection on the x-axis of the acceptable position error for the reference X, of the movement of the 
robot system, nestled on the x-axis in the interval (ax, box), where aox and box are the negative and 
positive maximum acceptable position errors, respectively the projection on the f-axis for the force 
reference of the movement Xpo, included in the interval (aof, bop), where aof and bor are the maximum 
accepted positive and negative force errors [15]. 

There results a positive transition domain DTP which projects onto the x-axis as the positive 
transitive position interval Xcr and onto the f-axis as the positive transitive force interval Xrcr. The 
interval Xcr corresponds to the critical error in position in which it is still possible to control the 
position movement of the robotic system in order to bring the position error into the standard 
positive domain. The x-axis projection is limited by the interval (ax, bx), where a, and bx are the 
positive, respectively negative maximum accepted critical errors. The interval Xfer corresponds to 
the critical error in force in which force control of the movement is still possible with the aim of 
bringing it into the standard positive domain and is limited by the interval (as, bf), where af and br 
are the positive, respectively negative maximum acceptable critical force errors. 

A negative transition domain DTN which is continued with the standard negative domain DSN to 
compose the universe of discourse U corresponds to unacceptable errors in position from which the 
position control of the robotic and mechatronic system SRM cannot recover to the standard positive 
domain, respectively unacceptable errors in force from which the force control cannot recover to the 
standard positive domain. Assigning values from this field would lead to saturation of the position 
or force reaction loop, with all negative consequences thereafter. The projection on the x-axis is 
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nestled on the x-axis in the interval (cx, dx) where cx and dx are the negative and positive maximum 
unacceptable position errors, respectively the projection on the f-axis is included in the interval (cs, 
dr) where cr and dr are the maximum unacceptable positive and negative force errors. 

A standard negative domain DSN which completes the univers of discours U and 
corresponds to unacceptable errors in position and force. The universe of discourse U is composed 
of the sum of the domains presented before. 

Having the defined domains of the universe of discourse, Linear and Non-Linear Attraction 
Point Principle is applied to the definition of metrics with the aim of determining the Linear (or 
Non-Linear) Dependent n-D-Function of point along the curve c and the Extension n-D-Distance 
between a point P(x/, x2, ..., xn) and the n-D-set S as p((x1, x2, ..., xn),S). 


Linear and Non-Linear Attraction Point Principle 


Optimal position-force control of a robot implies the tendency, in a linear or non-linear universe of 
discourse, towards an attraction point which ensures maximum performance. 
The Linear and Non-Linear Attraction Point Principle is the following [3]: 

Let S be an arbitrary set in the universe of discourse U of any dimension, and the optimal 
point O€ S . Then each point P(x/, x2, ..., xn), n > 1, from the universe of discourse (linearly or 
non-linearly) tends towards, or is attracted by, the optimal point O, because the optimal point O is 
an ideal of each point. There could be one or more linearly or non-linearly trajectories (curves) that 
the same point P may converge on towards O. Let’s call all such points’ trajectories as the Network 
of Attraction Curves (NAC). 

It is a kind of convergence/attraction of each point towards the optimal point. There are 
classes of examples and applications where such attraction point principle may apply. 

If this principle is good in all cases, then there is no need to take into consideration the 
center of symmetry of the set S, since for example if one has a 2D factory piece which has 
heterogeneous material density, then its center of weight (barycenter) is different from the center of 
symmetry. 

Starting from the one-dimensional extension theory of Cai Wen, generalizations were 
necessary for n-dimensional spaces in order to define a measurable space and n-D extension 
distance with the aim of applying domain extension transformations in position Sx, and force Sgf 
respectively, which would lead to solving the contradiction in robot hybrid force — position control. 


1. We generalized in the track of Cai Wen’s idea the extension /D-set to an extension n-D- 
set, and defined the Linear (or Non-Linear) Extension n-D-Distance between a point P(x/, x2, ..., 
xn) and the n-D-set S as p( (x1, x2, ..., xn), S ) on the linear (or non-linear) direction determined by 
the point P and the optimal point O (the line PO, or respectively the curvilinear PO) in the 
following way: 

a) p( (x1, x2, ..., xn), S ) = the negative distance between P and the set frontier, if P is inside 
the set S; 

b) p( (x1, x2, ..., xn), S ) = 0, if P lies on the frontier of the set S; 

c) p( (xl, x2, ..., xn), S ) = the positive distance between P and the set frontier, if P is 
outside the set. 


2. The Linear (or Non-Linear) Dependent n-D-Function of point P(x/, x2, ..., xn) along 
the curve c, is: 


Pe((X1, X2,..., Xn), $2) 


Knd(X1.X2..... Xn) = Ao 
Pe((X1, X2,...,Xn), $2) — Pe((X1, X2,.... Xn), $1) a) 
which has the following property: 

a) If point P(x1, x2, ..., xn) €Int(S1), then KnD(x1, x2,..., xn) > 1; 


b) If point P(x1, x2, ..., xn) €Fr(S1), then KnD(x1, x2,..., xn) = 1; 


264 OPTIROB 2013 


c) If point P(x1, x2, ..., xn) €Int(S2-S1), then KnD(x1, x2,..., xn) € (0, 1); 
d) If point P(x/, x2, ..., xn) €Int(S2), then KnD(x1, x2,..., xn) = 0; 

e) If point P(x1, x2, ..., xn) €Int(S2), then KnD(x1, x2,..., xn) < 0. 

Let’s see in figure 3 such example in the 2D-space. 





Fig. 3. The optimal point O as an attraction point for all other points P1, P2, ..., P8 in the universe 
of discourse R2 


In general, in a universe of discourse U, let’s have an n-D-set S and a point P. 
Then the Extension Linear n-D-Distance between point P and set S, is: 


—d(P.P'), 
P'eFr(S) P#0O.Peé| OP'|; 
P(P.S) =< ad(P.P'), P#0O,P'e|OP|; 
P’eFr(S) 
P=0O. 
—maxd(P.M). 
MeFr(S) 


(2) 
where O is the optimal point (or linearly attraction point); d(P,P’) means the classical linearly n-D- 
distance between two points P and P’; Fr(S) means the frontier of set S; and |OP’| means the line 
segment between the points O and P’ (the extremity points O and P’ included), therefore PE|OP’| 
means that P lies on the line OP’, in between the points O and P’. 


For P coinciding with O, one defined the distance between the optimal point O and the set S as the 
negatively maximum distance (to be in concordance with the /D-definition). 


The Extension Non-Linear n-D-Distance between point P and set S, is: 





—d-(P.P'). . 
P'eFr(S) P#0O.Pe€ec(OP'): 
pl P,S) =< d(P.P'). P#0O.P'ec(OP): 
P'eFr(s 
ms P=0. 


i= d P.M). 


MeFr(S),Mec(O) 


(3) 
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where p c(P, S)means the extension distance as measured along the curve c; O is the optimal point 
(or non-linearly attraction point); the points are attracting by the optimal point on trajectories 
described by an injective curve c; dc(P,P’) means the non-linearly n-D-distance between two points 
P and P’, or the arclength of the curve c between the points P and P’; 
Fr(S) means the frontier of set S; and c(OP’) means the curve segment between the points O and P’ 
(the extremity points O and P’ included), therefore P€c(OP’) means that P lies on the curve c in 
between the points O and P’. 

For P coinciding with O, one defined the distance between the optimal point O and the set S 
as the negatively maximum curvilinear distance (to be in concordance with the /D-definition). 


The System Architecture for the Extension Hybrid Force-Position Robot Control. 


We intend to replace the Sx and Ss matrices which contain crisp logic values with Kx and Ke which 
contain values of the dependent function of the position error Kx and the force error K¢ with respect 
to the standard positive field. Thus, considering the universe of discourse in figure 2 we will replace 
the crisp logic values 1 in matrices Sx and Sp with the Kx and Kẹ coefficients which result from the 
error positioning corresponding to the standard positive field [15]. 

The architecture of the Extension Position-Force Control System, presented in Figure 4, 
consists of a series of modules whose aim is to solve the contradictory problem of hybrid position — 
force control for the movement of robotic and mechatronic systems. This is obtained conceptually 
by replacing the 0 and 1 logic values from the selection matrices Sx and Sf, depending on the 
position-force sequences in Cantor logic, with values of the dependent function using extension 
distance. This is followed by a domain extension transformation for position Sgx, respectively for 
force Sx, which generates a new selection matrix with correlation coefficients for position and 
force respectively. 

Thus, a module which calculates the position extension distance CDEP, receives the current 
position signal X processed by a Carthesian coordinate calculation module CCC through direct 
cinematic, of the robotic and mechatronic system SRM and in reference to the standard positive 
interval of the position reference Xo, defined experimentally, calculates the position extension 
distance p(X,X.), which it sends to the module calculating the position dependence function CFDP. 
The extension position distance p(X,X,), according to extension theory, is calculated as the distance 
from a point, in this case the current position signal X, to an interval, in this case the standard 
positive interval for reference position Xo. Similarly, the data for calculating the force extension 
distance is calculated by the CDEF module, which works quasi-simultaneously with the CDEP 
module which calculates the extension position distance. 

The position dependent function K(X, Xo, Xcr ) of the current position signal X in relation 
to the standard positive interval of the reference position X, and the transitive positive interval for 
position Xcr is determined according to extension theory in the CFDP module. This has the 
maximum value of K(X,.)=Mp equal to the proportional amplification component of the position 
controller on the standard positive interval for the reference position Xo. Moreover, in order to not 
saturate the position loop, the dependent function for position K(X, Xo, Xcr ) has a lower limit of 0 
if the current position signal X is within the intervals X, and Xcr. 
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Fig. 4. Architecture of the extension hybrid force-position control system 


Dependent function k(x), k(f) to enable the calculation of correlation do not have to rely on 
subjective judgments or statistics, it can quantitatively and objectively describe the elements having 
the nature or character at a certain extent and the process of quantitative change and qualitative 
change. This allows correlation function out of bias caused by subjective judgments. 

Appling equations (1)-(3) for 2D, in a universe of discourse U, let’s have a nest of two n-D- 
sets, SZ C S2, with no common end points, and a point P. 


Then the Extension Linear Dependent n-D-Function referring to the point P(x/, x2, ..., 
xn) is: 


p(P.S2) 


Kap( P) = ————_—_- 
p(P.S2)— p(P.S1) 


(4) 
where p (P, S 2) is the previous extension linear n-D-distance between the point P and the n-D-set 
S2. 


The Extension Non-Linear Dependent n-D-Function referring to point P(x1, x2, ..., xn) 
along the curve c is: 


Pe(P.S2) 


K.P) = 
Pe P.S2) — pl P, S1) 


(5) 


where p c(P,S2) is the previous extension non-linear n-D-distance between the point P and the n-D- 
set S2 along the curve c. 


Applications of the Extenics force-position control to 2D-Space in figure 5 is presented. We have 
a errors domain whose desired 2D-dimensions should be 20 mV x 30 mV, and acceptable 
2Ddimensions 22 mV x 34 mV. We define the extension 2D-distance, and then we compute the 
extension 2D-dependent function. 
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Fig. 5. Diagram of the extension 2D-dependent function 


We have a desirable domain A’B’C’D’ and an acceptable domanin ABCD [4]. The optimal opoint 
for both of them is O(17,11). 
a) The region determined by the rays OA and OD. 
The extension 2D-distance p between a point P and a set is the + distance from P to the 
closestfrontier of the set, distance measured on the line OP. Whence 
p (P, A’B’C’D’) = -|PP1| (6) 
p (P, ABCD) = -|PP2]. (7) 
The extension 2D-dependent function k of a point P which represents the dependent of the point of 
the nest of the two sets is: 
p(P.bigger _set) p(P. ABCD) PPa) | PP: 


(P)=+ =+ =+ =+ ; 
kC p(P. bigger _sef)— p(P,smaller _ sef) P(P. ABCD) — p(P,A'B'C')  |PP21|-|PP:| | PiP>| 





(8) 


In other words, the extension 2D-dependent function k of a point P is the 2D-extension distance 
between the point and the closest frontier of the larger set, divided by the 2D-extension distance 
between the frontiers of the two nested sets; all these 2D-extension distances are taken along the 
line OP. 

b) The region determined by the rays OC and OD. Similar result would obtain if one gets 
the opposite region determined by the rays OA and OB. If one takes another region determined by 
the rays OC and OD and a point Q(x1,y1) in between one gets: 


k(Q) = k(x, y1) = 410021 
| AQ? | 
(9) 
A complete calculation is presented in [4]. 

A new selection matrix Sxx with the correlation coefficients for position is generated by the 
extension transformation module for position TExP which receives the dependent function signal 
for position K(X, Xo, Xcr ) from the CFDP module and replaces the elements with value 1 in the 
position selection matrix with correlation coefficients for position , determined through an 
extension transformation in domain. For force similar processing takes place by using the CDEF, 
CFDF, TExF AND CEF modules, while quasi-simultaneously applying the position processing. 

By applying the explicit sequential force-position control method on the two components, 
position in the CEP module and force in the CEF module, the position error and force error signals 
€xx and €x¢ respectively are determined with the aim of closing the system control loop in position 
and in force. 
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The implementation methodology of this advance method for hybrid position-force control of the 
walking robot consists in determining experimentally the standard positive field and the transient 
positive field for each control component, applying the transformation on the force and position 
error taking into account their real position in relation to the standard positive field, defined by 
points aox and box for position, respectively aof and bo¢for force, resulting in a transformed position 
and force error which represents the optimized function for hybrid position-force control. 

The universe of discourse is configured to admit a transient negative field, defined by points 
cx and dx for position, respectively cr and dr for force, so that passing these points the position and 
force errors will be limited so as not to lead to controller saturation and all the negative effects that 
derive from it. 


Results and conclusions 


The obtained results lead to an advanced method of solving the contradictory problem of hybrid 
position-force control for robot movement by applying an “Extension Set”, which allows the two 
contradictory elements, force and position, to be controlled simultaneously in real time, allowing 
for improvements in the movement precision and stability of the robot. Starting from the extended 
distance given by Prof. Cai Wen the dependent function in 2D space generated in position and force 
is determined. 

By replacing crisp logic values in the Sx and Sr matrices depending on the force-position 
sequence with values of the Extension Distance and Dependent Function for 2D space given by 
Smarandache, a method is developed for optimizing hybrid position-force control which ensures 
positioning precision and stability for the robot. 

The final conclusion lead to the development of a methodology which will allow high level 
results for hybrid force-position control, by using an extended transformation using as an 
optimization function the dependence function based on extension distance, in comparison to the 
classical method using sequential matrices corresponding to Cantor logic. 
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